int32 id     #0:unknown
int32 color  #0:unknown 1:red 2:blue
geometry_msgs/PoseStamped pose   #时间戳填传感器采集时间戳，坐标系选map(地图坐标)或base_link(底盘坐标系)
